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Angular velocity nonlinear observer from single vector 

measurements 

Lionel Magnis, Nicolas Petit 


Index Terms —Sensor and data fusion; nonlinear observer and filter 
design; time-varying systems; guidance navigation and control. 

Abstract —The paper proposes a technique to estimate the angular 
velocity of a rigid body from single vector measurements. Compared 
to the approaches presented in the literature, it does not use attitude 
information nor rate gyros as inputs. Instead, vector measurements are 
directly filtered through a nonlinear observer estimating the angular 
velocity. Convergence is established using a detailed analysis of a linear¬ 
time varying dynamics appearing in the estimation error equation. 
This equation stems from the classic Euler equations and measurement 
equations. As is proven, the case of free-rotation allows one to relax the 
persistence of excitation assumption. Simulation results are provided to 
illustrate the method. 

I. Introduction 

This article considers the question of estimating the angular veloc¬ 
ity of a rigid body from signals from embedded sensors. This general 
question is of particular importance in various fields of engineering, 
and in particular for the problem of orientation control, as shown 
in numerous applications E, 0, 0, 0 for spacecraft, unmanned 
aerial vehicles, guided ammunitions, to name a few. 

In the literature, two types of methods have been proposed to 
address this question. First, one can directly measure the angular 
velocity by using a specific sensor. This straightforward solution 
requires a strap-down rate gyro |5|. However, rate gyros being 
relatively fragile and expensive components, prone to drift, this 
solution is often discarded. The alternative is a two-step approach. 
In the first step, attitude is determined from measurements of known 
reference vectors. Then, in the second step, attitude variations are 
used to estimate the angular velocity. 

The first step is detailed in (6). In a nutshell, when two independent 
vectors are measured with vector sensors attached to a rigid body, the 
attitude of the rigid body can be found under the form the solution of 
the Wahba problem j7) which is a minimization problem having as 
unknown the rotation matrix from a fixed frame to the body frame. 
Thus, at any instant, full attitude information can be obtained 0 , El, 
Go), CD. In principles, this is sufficient to perform the second step: 
once the attitude is known, angular velocity can be estimated from a 
time-differentiation. However, noises disturb this process. To address 
this issue, introducing a priori information in the estimation process 
allows one to filter-out noises from the estimates. Following this 
approach, numerous observers based on the Euler equations have been 
proposed to estimate angular velocity from full attitude information 

E, D21. ED, DU- 

Besides this two-step approach, which requires measurements of 
two independent reference vectors, a more direct and less requiring 
solution can be proposed. In this paper, we expose an algorithm that 
directly uses the measurements of a single vector and reconstructs 
the angular velocity in a simple manner, by means of a nonlinear ob¬ 
server. This is the contribution of this article. In a related philosophy, 
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we have recently proposed an observer using the measurements from 
two linearly independent vectors as input Dll- The present paper 
studies a similarly structured observer. However, due to the fact that 
here only a single vector measurement is employed, the arguments of 
proof are completely different, and result in a new and independent 
contribution. 

The paper is organized as follows. In Section [ll| we introduce 
the notations and the problem statement. We analyze the attitude 
dynamics (rotation and Euler equations) and relate it to the mea¬ 
surements. In Section [in] we define the proposed nonlinear observer. 
The observer has an extended state and uses output injection. To 
prove its convergence, the error equation is identified as a linear 
time-varying (LTV) system perturbed by a linear-quadratic term. 
Under a persistent excitation (PE) assumption, the LTV dynamics 
is shown to generate an exponentially convergent dynamics. This 
property, together with assumptions on the inertia parameters of 
the rigid body, reveal instrumental to conclude on the exponential 
uniform convergence of the error dynamics. Importantly, the PE 
assumption is proven to be automatically satisfied in the particular 
case of free-rotation. In details, in Section E3 we establish that for 
almost all initial conditions, the PE assumption holds. This result 
stems from a detailed analysis of the various types of solutions to 
the free-rotation dynamics. Illustrative simulation results are given in 
Section [V] Conclusions and perspectives are given in Section [VI] 

II. Notations and problem statement 
A. Notations 

Vectors in R 3 are written with small letters x. \x\ is the Eu¬ 
clidean norm of x. [x x ] is the skew-symmetric cross-product matrix 
associated with x , i.e. Vy £ R 3 , [x x ]y = x x y. Namely, 

( 0 -X3 x 2 \ 

x 3 0 -xi J 

—X2 Xi 0 / 

where xi,x 2 ,X 3 are the coordinates of x in the standard basis of 

R 3 . If x is a unit vector, we have 

r 12 t T 

[x x J —xx — 1 

Vectors in R 6 are written with capital letters X. \X\ is the 
Euclidean norm of X. The induced norm on 6 x 6 matrices is noted 
|| • ||. Namely, 

\\ M \\ — max |MX| 

|X| = 1 

For convenience, we may write X under the form 

x= (xT,x?y 

with Xi,X 2 £ R 3 . Note that 

|X| 2 = \Xi\ 2 + |x 2 | 2 

Frames considered in the following are orthonormal bases of R 3 . 
Rotation matrix. For any unit vector u £ R 3 and any ( € R, 
r u (C) designates the rotation matrix of axis u and angle f. Namely 

r u (C) = cos £I + sin £[u x ] + (1 — cos Quu T 
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B. Problem statement 

Consider a rigid body rotating with respect to an inertial frame IZi. 
Note R the rotation matrix from TZ t to a body frame IZb attached 
to the rigid body and 0 the corresponding angular velocity vector, 
expressed in 7 Zb. Assuming that the body rotates under the influence 
of an external torque r (which, is null in the case of free-rotation), the 
variables R and 0 are governed by the following differential equations 

R = R[ 0 x] (1) 

0 = J -1 (J 0 X 0 + t) 4 E{ 0 ) + J~\ (2) 

where J = diag(Ji, J 2 , J 3 ) is the inertia m atrip] Equation is 
known as the set of Euler equations for a rotating rigid body |i 2 l- 
The torque r may result from control inputs or disturbance^] We 
assume that J and r are known. 

We assume that a constant reference unit vector a expressed in 
IZi is known, and that sensors arranged on the rigid body allow to 
measure the corresponding unit vector expressed in IZb. Namely, the 
measurements are 

a(t) = R{t) T a (3) 


For implementation, the sensors could be e.g. accelerometers, mag¬ 
netometers, or Sun sensors to name a few da. We now formulate 
some assumptions. 

Assumption 1. 0 is bounded : |0(£)| < 0 ma x at all times 


Assumption 2 (persistent excitation). There exist constant parame¬ 
ters T > 0 and 0 < pi < 1 such that a(-) satisfies 

jiJ [ a ( T )x] T [o(r)x]dT > fil, Mt (4) 

The problem we address in this paper is the following. 


Problem 1. Under Assumptions 7|2 find an estimate 0 of 0 from the 
measurements a defined in ([3]). 


Remark 1 (on the persistent excitation). is equivalent to 

i J (r T a(r)) dr < 1 - /z, Mt, V|*| = 1 (5) 

which is only possible if a(-) varies uniformly on every interval [t, t+ 
T\. Without the PE assumption, Problem [7 ] may not have a solution. 
For example, the initial conditions 


a(t 0 ) 




yield a(t) — a (to) for all t, regardless of the value of w. Hence, the 
system is clearly not observable. Such a case is discarded by the PE 
assumption. Note that this assumption bears on the trajectory, hence 
on the initial condition X(to) and on the torque r only. 


III. Observer definition and analysis of convergence 
A. Observer definition 

The time derivative of the measurement a is 

a — R t a — — [ 0 x ]R T cl — a x 0 

To solve Problem [T] the main idea of the paper is to consider the 
reconstruction of the extended 6 -dimensional state X by its estimate 



Without restriction, we consider that the axes of IZb are aligned with the 
principal axes of inertia of the rigid body. 

2 In the case of a satellite e.g., the torque could be generated by inertia 
wheels, magnetorquers, gravity gradient, among other possibilities. 


The state is governed by 

■ _ ( a x 0 
( E{ 0 ) + J~\ 

and the following observer is proposed 


X = 


a x 0 — k(a — a) 

E{ 0 ) + J -1 r + k 2 a x (a — a) 

where k > 0 is a constant (tuning) parameter. Note 


the error state. We have 

—kl 


X = 


k 2 [a x ] 


X + 


0 

E( 0 ) — E{ 0 ) 


( 6 ) 


(7) 


( 8 ) 


B. Preliminary change of variables and properties 

The study of the dynamics employs a preliminary change of 


coordinates. Note 


Z = 


(9) 


yielding 


with 


Z — kA(t)Z + I e( 0 )—e( 0 ) 

k 


A(t) = 


( 10 ) 


-I [a(f) x 

[a(f) x ] 0 

which we will analyze as an ideal linear time-varying (LTV) system 
Z = kA(t)Z (11) 

perturbed by the input term 




0 

E{0) — E{0) 
k 


( 12 ) 


We start by upper-bounding the disturbance ( fl2| ). 

Proposition 1 (Bound on the disturbance). For any Z, £ is bounded 
by 

Id < d(V 20 max \Z\ + k\Z\ 2 ) 


/ 

J 3 -J 2 


Ji-Js 


J 2 -J 1 

X 

l 

Jl 

5 

■h 

5 

Js 

/ 


where d is defined as 
d = max < 

Proof. We have 

iq = 1 \ e ( 0 )- e ( 0 )\ 

with, due to the quadratic nature of /?(•), 


(13) 


(14) 



— J 1 (J 0 X 0 + J 0 X 0 — J 0 X 0 ) 

(0203 + 0203) \ j 

( V 30203 

(0301 + 0301) — 

V l030 i 

(0102 + 0102 ) J 

( Jl V 20102 , 


As a straightforward consequence 

N < d|0| 2 

Moreover, by Cauchy-Schwarz inequality 

(0203 + 0203 ) ^ (02 + 03)(02 + 03 ) ^ (02 + 03 ) 101 

Using similar inequalities for all the coordinates of Si yields 

|<5l| 2 < 2d 2 |0| 2 |0| 2 < 2d 2 0max|0| 2 
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Hence, 


and 


III < N | N < dV 2 0n 


kd 


< d(\/20max|^'| + 


□ 


Remark 2 (on the quantity d ). As Ji, J 2 , J 3 are mam moments 
of inertia of the rigid body, we have HB (§32,9) 


Ji ^ J j + Jk 


for all permutations i, j, k and hence 0 < d < 1. Moreover, d = 0 if 
and only if Ji = J 2 = J 3 . d appears as a measurement of how far 
the rigid body is from an ideal symmetric body. For this reason, we 
call it distordance of the rigid body. Examples: 


• For a homogeneous parallelepiped of size l x l x L, with L > l, 
we have 


d = 


L 2 -l 2 
L 2 + 1 2 


• For a homogeneous straight cylinder of radius r and height 
we have 


|fe 2 - 3r 2 
h 2 + 3 r 2 


h 


C. Analysis of the LTV dynamics Z = kA(t)Z 

The shape of A(t) will appear familiar to the reader acquainted 
with adaptive control problems. Along the trajectories of 0 we 
have 

J t \z\ 2 = -2fc|Zi| 2 = -Z T C T CZ 

with 

C = (V2k 0) 

As will be seen in the proof of the following Theorem, the PE 
assumption will imply, in turn, that the pair ( kAf ), C) is uniformly 
completely observable (UCO), which guarantees uniform exponential 
stability of the LTV system. 

Theorem 1 (LTV system exponential stability). There exists 0 < 
c < 1 depending only on T,p,k and 0 ma x such that the solution of 
HD satisfies for all integer N > 0 

\Z(t)\ 2 <c N \Z(to)\ 2 , We [to + NT,to + (N + 1)T] 

for any initial condition to, Z(to). 


Proof. Along the trajectories of 0 we have 
A\Z\* = -2k\Z 1 \*<Q 
which proves the result for N — 0. For all t 

\Z(t + T)\ 2 = \Z(t)\ 2 - Z(t) 2 W(t,t + T)Z(t) 


where 


W(t,t + 



4>(t, t) T C T Cfi(r, t)dr 


is the observability Gramian of the pair (kA(-),C) and f is the 
transition matrix associated with 0- Computing W is no easy task. 
However, the output injection UCO equivalence result presented in 
d allows us to consider a much simpler system. Note 


K(t) = 


Vk 

V2 


I 

~[o(*)x] 


M(t) = kA(t) 



+ K(t)C 

k[a(t) x ] \ 

0 J 


The observability Gramian W of the pair ( M(-),C ) is easily com- 
puted as 

W(t,t + T) = 2k .st „ '.W 7, .s I dr 

where 


I A(r , t) 

A(t, t) T A(t, t) T A(r, t) 


A(r,t) — k J [a(u)x\dv 


Such a Gramian is well known in optimal control and has been 
extensively studied e.g. in GE Lemma 13.4. We have 

• ft +T k[a(r) X ] T k[a(r) x ]dr > Tk 2 pl, \/t 

• k[a(-) x ] is bounded by k 

• ^M a 0)x] is bounded by /c0 ma x 

from which we deduce that there exists 0 < < 1 depending on 

T, p, k , 0max such that 


W(t,t + T) > fill, Vt 


There also exists @2 > 0 depending on k, T such that 

W(t, t + T) < ^ 2 /. From [18), Lemma 4.8.1 (output injection UCO 
equivalence), W(t, t + T) is also lower-bounded. More precisely, we 
have 

with 0 < c < 1. Assume the result is true for an integer N > 0. For 
any t £ [to + NT, to + (N + 1 )T] we have 

| Z(t +T) I 2 = \Z{t)\ 2 - Z(t) T W(t, t + T)Z(t) 
<c\Z(t)\ 2 <c N+1 \Z{t 0 )\ 2 


which concludes the proof by induction. 


□ 


D. Convergence of the observer 
Consider the quantity 

d * = ? IT 05) 

4 \ 0max 

where c is defined in Theorem [I] The following Theorem, which is 
the main result of the paper, shows that if d < d*, the observer 
gives a solution to Problem [T] 

Theorem 2 (main result). We suppose that Assumptions \1\2\ are 
satisfied and that 

d < d* 


where d* is defined in 0. The observer © defines an error 
dynamics for which the equilibrium 0 is locally uniformly expo¬ 
nentially stable. The basin of attraction of this equilibrium contains 
the ellipsoid 

jx(0), |o(0)| 2 + ^^ <r 2 J (16) 

with 

2 a (1 -c) 3 ( 2 v / 2dr0 m **\ 

r = 8V5w l 1 —r^J < 17 > 

Proof. Consider the candidate Lyapunov function 

V(t,Z) ±Z T ( [ + °° 4>(T,t) T 4>(T,t)dr\ z 
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where f is the transition matrix of system (CD- Let (t,Z) be fixed. 
One easily shows that kA(-) is bounded by ky/ 3. Thus (see for 
example |20| Theorem 4.12) 

2 fc 7 ! |z|2 " Cl|z|2 “ m(z) 

Moreover, Theorem [I] implies that 

+ °° pt+(N+l)T 

V(t,Z)=J2 Z T 0(r,t) T 0(T,t)Z 

N =0 Jt+ NT 

+oo ^ 

<tJ2 cN \z\ 2 = y^- c \z\ 2 

N =0 

± c 2 \Z\ 2 ±W 2 {Z) 


By construction, V satisfies 

^(t, Z) + 2L V(t, Z)kA(t)Z = -\ZI 2 
Hence, the derivative of V along the trajectories of flTTe} 




Using 


m v[t - z) 


as 2 


r + OO 

l ' 


0(r, t) T 0(r, t)drZ 




together with inequality du yields 
2 dT 


dV 

az^t 


< f^- c [V 2 0max \z\ 2 + k\Z\ 3 ^ 


Hence 


= -W 3 (Z) 


2v / 2dT0 max 2 dTk 

1 — c 1 — c 


IZI 


By assumption d < cT, which implies 

^ _ 2y/2dT 0max q 

1 — c 

We proceed as in f[20l Theorem 4.9. If the initial condition of jnTBji 
satisfies 


\Z(t 0 )\<r 

U I ' 7 /+ 'll ^ 1 — c / 2v / 2dT0max\ IcT 

* lz{to)l < 2dvr{ 1 -J x V ^ 

then W 3 (Z(to)) > 0 and, while Ws(Z(t)) > 0, Z(-) remains 
bounded by 

\ Z (t )\ 2 < < UU < —|z(f 0 )| 2 

Cl Cl Cl 

which shows that 

w 3 (z) >(i~ 2 ^^ max - i^i 2 

From 1201 . Theorem 4.10, i(nrB} is locally uniformly exponentially 
stable. From 0. one directly deduces that the basin of attraction 
contains the ellipsoid (l6] >. □ 

Remark 3. The limitations imposed on a(0) in © are not truly 
restrictive because , as the actual value a(0) is assumed known, the 
observer may be initialized with a(0) = 0. What matters is that the 
error on the unknown quantity 0(0) can be large in practice. 


IV. PE ASSUMPTION IN FREE-ROTATION 

The PE Assumption [2] is the cornerstone of the proof of the main 
result. It is interesting to investigate whether it is often satisfied 
in practice (we have seen in Remark [T] that it might fail). In this 
section we consider a free-rotation dynamics, namely r — 0. We will 
prove that Assumption [2] or equivalently condition ([5}, is satisfied 
for almost all initial conditions. 

The following important properties hold. 

• u T Juj is constant over time (which implies that Assumption |T| 
is satisfied) 

• The moment of inertia of the rigid body expressed in the inertial 
frame 

M 4 R(t)Ju>(t ) (18) 

is constant over time. 

• Thus, any trajectory t i-A cj(t) lies on the intersection of two 
ellipsoids 

uj T Juj — uj(to) T Joj(to), uj t J 2 uj — uj{to) T J 2 uj{tf) 

The analysis of the intersection of those ellipsoids is quite involved 
and has been extensively studied in e.g. (Hi. It follows that there 
are four kinds of trajectories for the solutions uj of 0. We list them 
below, where {uj\ ,^ 2 ,^ 3 ) are the coordinates of uj in the body frame. 

Type 1 uj is constant, which is observed if and only if u(to) is 
an eigenvector of J. 

Type 2 J± > J 2 > J 3 singular case : uJi(t) and uj3(t) vanish, 
uj2(t) tends to a constant when t goes to infinity. This 
situation is observed only for a zero-measure set of initial 
condition uj(to). 

Type 3 Ji > J 2 > J 3 regular case : the trajectory is periodic and 
not contained in a plane. This situation is observed for 
almost all initial condition uj(to). 

Type 4 the trajectory is periodic and draws a non-zero diameter 
circle. This situation is observed if and only if two moments 
of inertia are equal and uj(to) is not an eigenvector of J. 
Examples of such trajectories are given in Figures |1|2| for various 
initial conditions. 



Type 2 


Fig. 1. Types 1, 2 and 3 trajectories in the case J\ > J 2 > J 3 on an ellipsoid 
corresponding to a constant |M| 


A. Study of Type 1 and Type 2 solutions 

The simplest case one can imagine is when uj(to) (or simply uj) 
is an eigenvector of J, namely for i — 1,2 or 3 

Juj = JiUJ 
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Note 

R 0 = R(t 0 ), w = |w|, u=Ir 0 u> 

Proposition 2. For all t, R(t) writes 
R(t) — r u (wt)R 0 

= Cwtl + &wt[u x ] + (1 — 3 wt)uu T ^j Ro 
where J s stand for cos, sin respectively. 

Proof Rif) and r u (wt)Ro have the same value R(to) for t s= to. 
Moreover, 

-r u (wt)Ro = ic Rwtl + b wt[u x ] + fiu+im T ^ Ro 
= ^wt[u x ] + BuV[u x ] 2 ) 

— (jvtl + Bict[u x ]) in[ux]Ro 

— (^wtl + Bict[u x ] + (1 — b wt)uu T ^j w[u x ]Ro 

— r u (wt)w[u x ]R 0 
r u (wt)[R 0 u x ]Ro r u (wt)R 0 [u x ] 

Thus both functions satisfy 0. which concludes the proof by 
Cauchy-Lipschitz uniqueness theorem. □ 


we have 


l ( T \ 2 

/ ( a(s) x) ds — 

rt-\-T 

- / (aixi + (a2 b wt + a3&wt)x2 + (<23 jwt — a2^wt)x3)ds 

Jt 


l r*+ T 

T 

2 2 

22. ^2 +<23/2. 2\ / /-1 \ 

— diXi H--- [X 2 + X 3 ) < (1 — p) 


with 


n = min (l-o?, 1 +* ) € ( 0 , 1 ) 


Thus, condition {5} is satisfied. 

3) Type 2 solutions: As shown in m, the Type 2 solutions are 
characterized by J\ > J 2 > J 3 and 


|wi(lo)| = 


J 3 (J 2 - J 3 ) 

MJ 1 -J 2 ) 


|w 3 {to) | 7 ^ 0 


which defines a zero-measure set. For this reason, they are called 
singular solutions. In this case, ujif) converges to a limit uj 00 = 
(0, ±w, 0) when t goes to infinity. The rotation R(t) is thus 
asymptotically arbitrarily close to a planar rotation around M = 
R(to)Juj(to). The same arguments as in Sections |iV- A1 1 [fV- A2 show 
that condition (5} is satisfied unless R(to)Ju(0) and a are aligned. 


It follows that for all t , aif) writes, 

a(t) = R(t) T a (19) 

= b wtRo a — QwtRo (u x d) + (1 — jxf)u T aR^u 

For this reason, we call planar rotation the R(-) matrix generated by 
a Type 1 trajectory. 

Remark 4. The direction u of the rotation can be simply computed 
from M. We have 

M — RJuj — JiRu — wJ z RRqU — wJiu 


which implies that 


_M_ 

“ |M| 


The impact of the planar nature of the rotation on the PE assump¬ 
tion is as explained in the next two subsections. 

1) Type 1 solution with M aligned with a: Consider that a 
is aligned with M = R(to)Juj(to). In this case u — d=d (see 
Remark [ 4 ]). Thus, |T9] ) yields aif) — RqCl constant over time. For 
any T we have, for the unit vector x = Rq a 

T 

(a(s) T x) 2 ds = 1 

Thus, condition {5} is not satisfied. 

2) Type 1 solution with M not aligned with a: Conversely, 
consider that a is not aligned with M. Define v, z such that (u,v,z) 
is a direct orthonormal basis of R 3 . The decomposition of the unit 
vector a in this basis is given as 



a = aiu + a 2 V + a 3 Z, a\ + a% + <23 = 1 , with a\ < 1 


We have 


aif) —Rq (aiu + (a 2 „wt + a 3 $wt)v + {ao^wt — a 2 $>wt)z) 
For T = +V any t and any unit vector 

x — Ro (xiu + X2V + X3z) 


B. Study of Type 3 and Type 4 solutions 

In this section we will show that the Type 3 and Type 4 solutions 
satisfy the PE assumption. Both proofs relies on the following 
technical result. 


Proposition 3 (preliminary result). If condition 0 is not satisfied, 
then for all T > 0 and all e > 0 small enough, there exists t such 
that for all y £ R 3 , and all s £ [t, t + T\, 

• R(s)y remains between two planes orthogonal to a and distant 
by e\y\ 

• R(s) T y remains between two parallel planes distant by e\y\. 
Proof. Consider T > 0 and y such that 

0<f ‘ <min («t: ,l!! f i ) <1 (20) 

Assume that {5| is not satisfied. There exists t,x such that \x\ = 1 

and _ 

1 rt+ T , \ 2 

- J (a(s) T x) ds > 1 - p (21) 

As will appear, one can use the bounded variations of a(-) due to 
its governing dynamics to establish a lower bound on the integrand. 
Note 

h(s) = ^a(s) T x^ , Vs 

We will now show by contradiction that 

h(s) > 1-2a/T 0 ma x/2 ? Vs £ [f, t T] 

Assume that there exists so such that 

h(so) < 1 — 2 \/T0 max/2 

We have, for all s, 

\h(s)\ = |2a(s) T a;a(s) T x| 

— |2(a(s) x a;) T xa(s) T x| < 20 max 
Assume so < t + + and note 


A 1 

Si = So + 



< t + T 


0max 
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We have, for any s £ [so, si] C [£, t + T] 

/i(s) ^ /i(s 0 ) H - 20 max (s So) 

<1 2 7 / T 0max/^ + 20 max (s — So) 


Hence 


/ ,+T (» w v)^<i-iy2| 


+ T 


pj ^ 2 T 0 max /^ + 20 max (s so)^<is 


?=1 — 2/i + /i=l — /i 


which contradicts The case so > £ + ^ is analog with 

s € i s ° - so] C [£, t + T]. Finally, we have, for all s 

0 < 1 - 2A/T0 max /i < ^a(s) T a^ < 1 

which shows that the continuous function si-^a(s) T xisof constant 
sign, strictly positive without loss of generality. Thus, we have 

0 < 1 - 2v A T0maxM < a(s) T £ < 1 

and in turn 

|a(s) - x\ 2 = 2 - 2a(s) T £ < 4^/T0 max y = (22) 

Note Ri a rotation matrix so that 


a — R\x 

and, for all s, u(s),£(s) such that 

R(s) = r n(s) (^(s))f ? 1 


Note that f?(s)x = r u ( s )(^(s))a. The next Lemma formulates that 
the rotation R(s) is uniformly close to ra(£(s))Ri. 

Lemma 1. We have, for all s £ [t,t + T] and all y £ R 3 

\R(s)y - ri.(£(s))Riy\ 2 < 307^u|j/| 2 (23) 


Now, for B — 


\uXx\ 


we have 


■ ^ t 

|AL >| 2 = - 2 1^ X (u x x) — X X (u x x)| 2 

iC 2 ~^ 3 

sin 2 £ ,, t \21 . ,2 

= —^- 9(1 —a? u) u + x 

^2 “ 1 “ ^3 

= 4£!4 4 (i- a; ?) 2 

xl + xl v ' 


< 16(x| + x%) sin 2 - < 47 y/fl 


For C — A x B we have 


|AC| 2 = |Q_R(s)(A x B) - P(s)(vl x B)| 2 

= \QR(s)A x QR(s)B - P(s)A x P(s)B| 2 
= x AB + AAx P(s)B\ 2 

< 2(cy^t + 4c v /)'t) = 107^/1 

Finally, for any unit vector y — y± A + y 2 B + 2 / 3(7 we have 

|Ay| 2 as \yiAA + 1 / 2 A 5 + 2 / 3 ACI 2 

< 3 (y? |AA| 2 + yl \AB\ 2 + y 3 2 |AC| 2 ) 

< 3 (yl +y%+ 2 /f) 107 VM = 307 v //^|j/| 2 

which concludes the proof of Lemma [l] □ 

Note £ = 2y / 307^//i and consider any y in R 3 and any s in 
[£, t + T]. On the one hand, Va(^(s))Riy lies on a circle orthogonal 
to a. On the other hand, 

\R(s)y - r & (£{s))Riy\ < ||y| 

This yields the first item of Proposition [3] as y > 0 is arbitrary small. 
Rewriting the result of Lemma [T] as 

|#ir&(-£(s))2/- R(s) T y\ < 307^/I|2/| 2 

for any s £ [£, £ + T] and any y yields the second item and concludes 
the proof. □ 


1) Type 3 solutions: These solutions are characterized by J\ > 
J 2 > J 3 and 


where 7 is defined by { 22 }. 

Proof Let s £ [£, t + T\. For clarity we may omit the s dependency 
of u and £. Note 

A ±R(s)-ra(ORi 

= ^sin£ ([u x ] - [d x ]) + (1 - cos£) (uu T - dd T ^ Ri 

If a = u(s ), || A|| = 0 < 307 ^. Otherwise, for A — x we have, 
from { 22 } 

|AA | 2 = |R(s)x — ra(f)Rix \ 2 — \R(s)x — d | 2 
1 12 

= \x — R T (s)a\ —\x — a(s )| 2 < 

Note v, z so that (u, u, z) is an orthonormal basis of R 3 write 
a — a\u + 02 V + CL 3 W, a 2 + a 2 + a 2 = 1 

We have 

7 VT > \R(s)x - a \ 2 m |(r u (0 - I)a\ 

= |(o 2 U - 1) - a 3 fiOv + (026^ + o 3 U - !)) w | 2 

= 4(a 2 + 03 ) sin 2 | 


In this case the trajectory of cj(-) is closed and thus periodic of 
a certain period r > 0, and not contained in a plane. Assume 
that condition 0 is not satisfied. We apply the second item of 
Proposition [5] with T — r. For any e small enough, there exists 
t such that for all s £ [t, t + r] 

Jlu(s) = R t (s) M 

remains between two parallel planes and distant by £ |M|. As cj(-) 
is r— periodic, this is true for all s £ R. When s goes to 0, we 
conclude that the trajectory of cj(-) remains in a plane, which is 
a contradiction. Thus, condition {5} is satisfied, unconditionally on 
R(t 0 ). 

2) Type 4 solutions: We now consider the case where a; (to) is not 
an eigenvector of J and two moments of inertia are equal. In this 
case the trajectory t ca(t) is a circle, as represented in Figure [ 2 ] 
Since it is contained in a plane, we can not apply directly the same 
technique as in Section |IV-B 1 1 Without loss of generality, we study 
the case Ji = J 2 > J 3 (the case Ji > J 2 = J 3 is analog). We thus 
consider a trajectory uj such that u;(0) satisfies 

(cji(£ 0 ),^2(£o)) ^ (0,0), co 3 (to) / 0 
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UJ 2 


Fig. 2. Type 4 trajectories in the case J\ = J 2 > J 3 on an ellipsoid 
corresponding to a constant |M| 


Following the extensive analysis exposed in COD, we conveniently 
chose the inertial frame (ei,e2,es) so that e% is aligned with M, 
namely 


M 

' ]M| 


For this choice of e3 and in the case where J\ = J2, equations ([TJ- 
(2| simplify considerably and one can show that the rotation matrix 
satisfies for all t 


R(t) = p 


(...) 

(...) 


(...) 

(...) 


Mt - h) 

fi£l (t - tl) 


( 24 ) 


^ £2(t f2 ) B&it — tf) 


where (...) designates terms that are irrelevant in the following 
analysis, t\,t2 are constant and 


P = 




Jfcjl(fo ) 2 + </f^ 2 (to ) 2 + Ji^ 3 (to ) 2 


G ( 0 , 1 ) 


Jl 


£l — \ Ml (to) 2 +CJ2(fo) 2 + -^W3(to) 2 > 0 


Jl 


J3 


^2 = ( — — 1 ) U 3 (t 0 ) / 0 


We now show that condition 0 is satisfied by contradiction. As¬ 
suming that it is not, one can apply the first item of Proposition [ 3 ] 
with 


T — max 


27T 27r \ 


For £ small enough, there exists t such that for all s G [t , t + T] 
R(s)e3 remains between two planes orthogonal to a and distant by 
e. Moreover, expression ( | 24 ] > yields for all s 


which yields a = =be3 when £ goes to 0 . Hence for £ small enough, 
and all s G [t, t -j- T 1 ] 

R{s)ei = I (...) 

\ pcos£ 2 (s - t 2 ) 

remains between two planes orthogonal to a = ±63. Taking £ < 
2 p yields a contradiction. The trajectories R(t)e 1 and R(t)e 3 are 
represented in Figure [ 3 ] for better visual understanding of the proof. 



Fig. 3. R(t)e 3 (dashed) and R(t)e 1 (solid) evolving on the unit sphere 


C. Conclusion 

In this section we have shown the following result. 

Theorem 3. Consider the vector 

a(t ) = R(t) T a 

where R(t ) is a rotation matrix defined as the solution of the free- 
rotation dynamics 0-0 with r — 0. Assumption [2] is satisfied for 
almost all initial conditions (R(to),u(to)). It fails only in the cases 
listed below 

(i) u(to) is an eigenvector or J and R(to)Juj(to) is aligned with 
a, or 

(ii) the eigenvalues of J are of the form Ji > J 2 > J 3 , the coordi¬ 
nates of uj (to) in the trihedron of orthonormal eigendirections 
of J satisfy 

l “ i(, " )l - Jmr3T ) Mt))l < 251 

and R(to)Joj(to) is aligned with a. 

It follows that, except for the initial conditions listed in items 
(i), (ii), the conclusion of Theorem [ 2 ] holds without requiring As¬ 
sumption 2, which is automatically satisfied. Therefore, in almost all 
cases, observer 0 asymptotically reconstructs the desired angular 
velocity uj. 


( p cos £1 (5 - to \ 
psin£i(s — ti) 1 

- p 2 / 

Simple geometric considerations show that 

yi _ (a T e 3 ) 2 < J 


Y. Simulation results 

In this section we illustrate the convergence of the observer and 
sketch the dependence with respect to the tuning gain k. 

Simulations were run for a model of a CubeSat ED- The rotating 
rigid body under consideration is a rectangular parallelepiped of 
dimensions about 20 cm x 10 cm x 10 cm and mass 2kg assumed 

























Fig. 4. Typical measurements in the ideal noise-free case 

to be slightly non-homogeneously distributed. The resulting moments 
of inertia are 

Ji = 87 kg.cm 2 , J 2 — 83 kg.cm 2 , J 3 — 37 kg.cm 2 

No torque is applied on this system, which is thus in free-rotation. 
Referring to Section [IV] we will consider Type 1 and Type 3 
trajectories. 

In this simulation the reference unit vector is the normalized 
magnetic held a. The satellite is equipped with 3 magnetometers 
able to measure the normalized magnetic held y a in a magnetometer 
frame 7 Z m - 

It shall be noted that, in practical applications, the sensor frame 
7 Zm can differ from the body frame 7 Zb (dehned along the principal 
axes of inertia) through a constant rotation Rm,b- With these nota¬ 
tions, we have 

which is a simple change of coordinates of the measurements. 

For sake of accuracy in the implementation, reference dynamics 
and state observer ( 6 ) were simulated using Runge-Kutta 4 method 
with sample period 0.01s. The generated trajectories correspond to 
0ma x — 100 [rad/s]. 

A. Noise-free simulations 

To emphasize the role of the tuning gain k , we hrst assume that 
the sensors are perfect i.e. without noise. Typical measurements for 
a general Type 3 trajectory are represented in Figure [4] As J± and 
J 2 are almost equal, the third coordinate is almost (but not exactly) 
periodic. Figure [5] shows the convergence of the observer for various 
values of k. Interestingly, large values of k produce undesirable 
effects. This is a structural difference with the two reference vectors 
based observer previously introduced by the authors ED. The reason 
is that the convergence is guaranteed by a PE argument and not by 
a uniformly negative bound on eigenvalues. 

In Figure [ 6 ] we represented the observer error for a case where the 
PE assumption is not satisfied, namely for a constant u with M and 
a = (1,0,0) aligned. This is a singular case, as discussed earlier. 
Interestingly, the coordinates UJ 2 and U 3 converge to zero, while 
converges to a constant value. This can easily be proved by using 



Fig. 5. Convergence of the observer for increasing values of k 

LaSalle invariance principle. Indeed, in this case, uj is constant and 
the measurements o(-) satisfy a LTI differential equation. 



Fig. 6. Without the PE assumption asymptotic convergence of the observer 
is lost, a bias remains. 


B. Measurement noise 

We now study the impact of measurement noise on the ob¬ 
server performance. The simulation parameters remain the same 
but we add Gaussian measurement noise with standard deviation 
a = 0.03 [Hz - 2 ]. Typical measurements are represented in Figured 
The observer yields a residual error, about 5% in Figure [ 8 ] for k — 1. 
Note that the measurement noise is filtered, thanks to a relatively 
low value of the gain k. For large values of k , the observer does not 
converge anymore (not represented). 

VI. Conclusions and perspectives 

A new method to estimate the angular velocity of a rigid body has 
been proposed in this article. The method uses onboard measurements 
of a single constant vector. The estimation algorithm is a nonlinear 
observer which is very simple to implement and induces a very 
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Fig. 7. Vector measurement with additive noise 



Fig. 8. Observer performance under noisy measurement for k = 1 


limited computational burden. At this stage, an interesting (but still 
preliminary) conclusion is that, in the cases considered here, rate gy¬ 
ros could be replaced with an estimation software employing cheap, 
rugged and resilient sensors. In fact, any type of sensors producing 
a 3-dimensional vector of measurements such as e.g., Sun sensors, 
magnetometers, could constitute one such alternative. Assessing the 
feasibility of this approach requires further investigations including 
experiments. 

More generally, this observer should be considered as a first 
element of a class of estimation methods which can be developed to 
address several cases of practical interest. In particular, the introduc¬ 
tion of noise in the measurement and uncertainty on the input torque 
(assumed here to be known) will require extensions such as optimal 
filtering to treat more general cases. White or colored noises will be 
good candidates to model these elements. Also, slow variations of 
the reference vector a should deserve particular care, because such 
drifts naturally appear in some cases. 

On the other hand, one can also consider that this method can 


be useful for other estimation tasks. Among the possibilities are 
the estimation of the inertia J matrix which we believe is possible 
from the measurements considered here. This could be of interest for 
the recently considered task of space debris removal ED- Finally, 
recent attitude estimation techniques have favored the use of vector 
measurements together with rate gyros measurements as inputs. 
Among these approaches, one can find i) Extended Kalman Filters 
(EKF)-like algorithms e.g. [23, l24l . ii) nonlinear observers (25), 
(26) , (27), (28), (29), (30). This contribution suggests that, here also, 
the rate gyros could be replaced with more in-depth analysis of the 
vector measurements. 
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